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Abstract —In distributed mobile sensing applications, net¬ 
works of agents that are heterogeneous respecting both actua¬ 
tion as well as body and sensory footprint are often modelled by 
recourse to power diagrams — generalized Voronoi diagrams 
with additive weights. In this paper we adapt the body power 
diagram to introduce its “free subdiagram,” generating a 
vector field planner that solves the combined sensory coverage 
and collision avoidance problem via continuous evaluation of 
an associated constrained optimization problem. We propose 
practical extensions (a heuristic congestion manager that speeds 
convergence and a lift of the point particle controller to the 
more practical differential drive kinematics) that maintain the 
convergence and collision guarantees. 

I. INTRODUCTION 

Among the many proposed multiple mobile sensor coor¬ 
dination strategies [1], Voronoi-based coverage control [2] 
uniquely combines both deployment and allocation in an 
intrinsically distributed manner [3] via gradient descent (the 
“move-to-centroid” law) down a utility function minimizing 
the expected event sensing cost to adaptively achieve a 
centroidal Voronoi configuration (depicted on the left in 
Fig. 1). Since the original application to homogeneous point 
robots [2], a growing literature considers the extension 
to heterogeneous groups of robots differing variously in 
their sensorimotor capabilities [4]-[7] by recourse to power 
diagrams — generalized Voronoi diagrams with additive 
weights [8]. 

A. Motivation and Prior Literature 

Although it inherits many nice properties of a standard 
Voronoi diagram such as convexity and dual triangulability, 
a power diagram may possibly have empty cells associated 
with some (unassigned) robots and/or some robots may not 
be contained in their nonempty cells [8], as situation depicted 
on the middle in Fig. 1. Such occupancy defects (Definition 
1) generally cost resource inefficiency or redundancy', and, 
crucially, they re-introduce the problem of collision avoid¬ 
ance — the chief motivation for the present paper. 

Voronoi-based coverage control implicitly entails collision 
avoidance for point robots since robots move in their pair¬ 
wise disjoint Voronoi cells [2], but an additional collision 
avoidance strategy is mandatory for safe navigation of finite 
size robots. Existing work on combining coverage control 
and collision avoidance generally uses (i) either heuristic 
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^Note that a power diagram with an occupancy defect can be beneficial 
in certain applications to save/balance energy across a mobile network of 
power limited agents [7]. 
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Fig. 1. An illustration of (left) the Voronoi and (middle) power diagrams 
of an environment based on a noncolliding placement of point robots, where 
the weights of power cells are shown in parentheses. Although each point 
robot is always contained in its Voronoi cell, power cells associated with 
some robots (e.g. the 7th robot) may be empty and/or some robots (e.g. the 
1st and 4th robots) may not be contained in their nonempty power cells. 
(Right) A collision free disk configuration does not necessarily have Voronoi 
cells containing respective robot bodies. 

approaches based on repulsive fields [9], [10] and reciprocal 
velocity obstacles [11] causing robots to converge to con¬ 
figurations far from optimal sensing configurations; or (ii) 
the projection of a vector field whenever a robot reaches the 
boundary of its partition cell [4], [12] introducing a source of 
discontinuity. An important observation made in [4] is that 
it is sufficient to restrict robot bodies to respective Voronoi 
regions for collision avoidance, but this is a conservative 
assumption for robot groups with different body sizes (as 
illustrated on the right in Fig. 1). 

B. Contributions and Organization of the Paper 

In this paper, we provide a necessary and sufficient con¬ 
dition for identifying collision free configurations of finite 
size robots in terms of their power diagrams, and accord¬ 
ingly propose a constrained coverage control (“move-to- 
constrained-centroid”) law whose continuous and piecewise 
smooth flow asymptotically converges to an optimal sensing 
configuration avoiding any collisions along the way. We 
extend the practicability of the result by adding a congestion 
management heuristic for unassigned robots that hastens 
the assigned robots’ progress, and. Anally, adapt the fully 
actuated point particle vector held planner to the widely 
used kinematic differential drive vehicle model (retaining 
the convergence and collision avoidance guarantees in both 
extensions). 

This paper is organized as follows. Section II briefly 
summarizes coverage control of point robots. Section III 
discusses occupancy defects of power diagrams. In Section 
IV we introduce a novel use of power diagrams for identi¬ 
fying collision free multirobot configurations, and then pro¬ 
pose a constrained optimization framework combining area 
coverage and collision avoidance, and present its practical 
extensions. Section V offers some numerical studies of the 










proposed algorithms. Section VI concludes with a summary 
of our contributions and a brief discussion of future work. 


II. Coverage Control of Point Robots 


A. Location Optimization of Homogeneous Robots 

Let Q be a convex environment in with a priori 
known event distribution function f : Q ^ ]R>o that 
models the probability of some event occurs in Q, and 
p := (pi,p 2 ,... ,Pn) S Q" be a (noncolliding) placement 
of n G N point robots in Q? Suppose that the event 
detection (sensing) cost of ith robot at location q G Q is 
a nondecreasing differentiable function, / : R —R, of 
the Euclidean distance, ||q — pi||, between q and p^. Further 
assume that robots are assigned to events based on a partition 
of Q yielding a cover, W: = {Wi, W 2 , ■ ■ ■, Wn}, a collection 
of subsets (“cells”), Wi, whose union returns Q but whose 
cells have mutually disjoint interiors. ^ A well established 
approach (arising in both facility location [3], [13] and 
quantization [14], [15] problems) achieves such a cover by 
minimizing the expected event sensing cost. 


?f(p,W) 



/(l|q-pJ)</'(q) dq. 


( 1 ) 


Now observe that, for any fixed p, the optimal task 
assignment minimizing Jf is the standard Voronoi diagram 
V (p) : = {Vi,..., Vn} of Q based on the configuration p. 


K; = 


|qGQ ||q-p,|| < ||q-pjll ,Vj ^ . 


( 2 ) 


Thus, given the optimal task assignment of robots, the 
objective function Jf takes the following form 


Jfv (p):=Jf(p,V(p))=^ 

2=1 


[ /(l|q-Pi||)<A(q)dq,(3) 
JVi 


and it is common knowledge that [2], [3], [15] 


d^v (p) 
dpi 


Jv ^■^(lld-P*ll)</>(q)dq. 


(4) 


In the special case of / (x) = x^, the partial derivative of 
Tfv has a simple physical interpretation as follows: 

(pi - cyj , (5) 

where and cy, respectively, denote the mass and the 
center of mass of V) according to the mass density function 


mvi 


(l){q)dq, 


CVi 



(j){q) dq. 


(6) 


Assuming first order (completely actuated single integra¬ 
tor) robot dynamics. 


Pi = Uj, 


(7) 


^Here, N is the set of all natural numbers; M and R>o (]R>o) denote the 
set of real and positive (nonnegative) real numbers, respectively; and 
is the A^-dimensional Euclidean space. 

^We will generally refer to such decompositions as “diagrams” but also 
occasionally allow the slight abuse of language to follow tradition and refer 
to W as a partition. 


the standard “move-to-centroid” law asymptotically steering 
point robots to a centroidal Voronoi configuration with the 
guarantee of no collision along the way is 

Uj = -fc (pi - Cy) , ( 8 ) 

where k G R>o is a fixed control gain and the Voronoi 
diagram V (p) of Q is assumed to be continuously updated. 
Note that my and cy are both continuously differentiable 
functions of p as are both Jfy and u^ [16]. Finally, observe, 
again, that the coverage control u^ supports a distributed 
implementation whose local communications structure is 
specified by the associated Delaunay graph [2]. 


B. Location Optimization of Heterogeneous Robots 

In distributed sensing applications, heterogeneity of 
robotic networks in sensing and actuation [4]-[7] is of¬ 
ten modelled by recourse to power diagrams, generalized 
Voronoi diagrams with additive weights [8]. More precisely, 
for a given multirobot configuration p G Q", the event 
sensing cost of ith robot at location q G Q is assumed to be 
given by the power distance, ||q — Pi||^ —where pi G R>o 
is the power radius of zth robot. Accordingly, the task 
assignment of robots are determined by the power diagram 
T (p, p) : = {Pi, P 2 , ■ • ■, Pn} of Q based on the configura¬ 
tion p and the associated power radii p : = {pi,p 2 ,. ■., Pn), 



l|q-Pif 


P? < ||q-Pjf-Pj,Vj 7^i|,(9) 


and the location optimization function becomes 


li p 

= (llq-p*ll^-Pi)<?^(q)dq- (10) 

i=i Pt 


Note that in the special case of pi = pj for all i j the 
power diagram y{p,p) and the Voronoi diagram V (p) of 
Q are identical, i.e. Pi = Vi. 

Similar to (5), for fixed p, the partial derivative of TCy 
takes the following simple form [4], [7], [10], 

d'Ky{p,p) 

---= 2mp, (pi - Cpj , (11) 

OPi 

where mp^ and cp^ are the mass and the center of mass of 
Pi, respectively, as defined in (6). For the single integrator 
robot model (7), the standard “move-to-centroid” law of het¬ 
erogeneous robotic networks asymptotically driving robots to 
a critical point of TCy (., p), where robots are located at the 
centroids of their respective power cells, is defined as 


Ui =-fc (pi - cpj , (12) 

for some fixed k G R>o and the power diagram T (p, p) of 
Q is assumed to be continuously updated. Notwithstanding 
its welcome inheritance of many standard Voronoi properties 
(e.g., convexity, dual triangulability), a power diagram may 
yield empty cells associated with some robots and/or some 
robots may not be contained in their nonempty power cells, 
illustrated in Fig. 1. In consequence, contrary to the case 


To be well defined we set cp. = pi whenever Pi has an empty interior. 







of homogeneous robots, the “move-to-centroid” law of het¬ 
erogeneous point robots is discontinuous and it cannot guar¬ 
antee collision free navigation. Thus, in past literature, for 
robots of finite but heterogeneous size, the standard “move- 
to-centroid” law inevitably requires an additional heuristic 
collision avoidance strategy for safe navigation. 

III. Occupancy Defects of Power Diagrams 
Definition 1 {Occupancy Defect) The power partition, 
CP(p,p), associated with configuration p G Q" and radii 
p € (]R>o)" is said to have an occupancy defect if p^ ^ Pi 
for some i G {1,2,... n}. 

Configurations incurring occupancy defects introduce a 
number of problems. First of all, empty partition cells cause 
resource redundancy because some robots may never be 
assigned to any event happening around them. Such robots 
do not only become redundant, but also complicate collision 
avoidance as (moving or stationary) obstacles and limit the 
mobility of others. In general, robots that are not contained 
in their respective cells require an extra care for collision 
avoidance. 

A straightforward characterization of an occupancy defec¬ 
tive configuration is: ^ 

Proposition 1 Given radii p G (R>o)", configuration p G 
Q" does not incur an occupancy defective power diagram if 
and only if ||p* - > \p1 - p]\ for all i ^ j. 

Proof By Definition 1, CP (p, p) has no occupancy defect if 
and only if pi G Pi for all i, which is the case if and only if 

l|Pi-Pif-P? < l|Pi-Pif(13) 
l|Pj - Pjf - P] < IIPi - - Pi^ (14) 

for all i j. Thus, the result follows. ■ 

IV. Combining Coverage Control and Collision 
Avoidance 

Throughout the rest of paper, we consider hetero¬ 
geneous disk-shaped multirobot configurations, p = 
(pi, P 2 ,..., Pra) G Q", in Q with associated vectors of 
nonnegative body radii (3 := {fii, (32, ■ ■ ■, fin) S (R>o)" 
and sensory footprint radii cr : = (cti, tT 2 j ■ • ■, <Tn) C (R>o)"i 
where ith robot is centered at pi G Q and has body radius 
fii > 0 and sensory footprint radius ai > 0. Accordingly, 
we will denote by CB(p,/3) = {Bi, B 2 , ■ ■ ■, Bn}, a cover 
we term the body diagram of Q, solving the power problem 
(9), (10), defined from CK® (p,/3); and we will denote by 
§(p,<t) = {^i, 5'2, ..., 5'n}, a cover we term the sensor 
diagram of Q, solving the corresponding problem defined 
by CKs(p, cr). We also find it convenient to denote the 
configuration space of body-noncolliding disks of radii (3 
in Q as 

Conf(Q,/3) := {pGQ” 

D{p,,fii)(lQ V*}, (15) 


\\Pi-P3\\> fii+fij 


^In [5] the authors note the issue of empty power cells and give a similar 
sufficient condition for each robot to be contained in its power cell. 


where D (x, r): = {y G | || X — y|| < r} is the closed disk 
in K.^ centered at x G with radius r > 0, and Q is the 
interior of Q. Note that the vectors of body radii f3 and 
sensory footprint radii cr are not necessary equal since f3 
models the heterogeneity of robots in body size, cr models 
their heterogeneity in sensing and actuation. 


A. Encoding Collisions via Body Diagrams 

A geometric characterization of collision free multirobot 
configurations in Q via their body diagrams is: 

Proposition 2 Let 23 (p, (3) be the body diagram of Q 
associated with configuration p G Q" and body radii (3 G 
(M>o)"’. Then p is collision free if and only if every robot 
body is contained in the interior of its body cell, i.e. 

p G Conf ((5,/3) <5=^ £) (pi,/3i) c Si VT (16) 


Proof The sufficiency (<J=) follows because 23 (p,/3) is a 
cover of Q whose elements have disjoint interiors. Hence, 
given D{pi,fii) C Bi for all i, we have D{pi,fii) C Q and 
D {j>i,fii)r]D {pj,fij) = 0 for all i j, and so ||pi - p^ || > 
fii + fij. Thus, p G Conf {Q, (3). 

To see the necessity (=^), for any p G Conf {Q,(3) we 
will show that p^ G Bi for all i, and the distance between 
Pi and the boundary dBi of Bi is greater than fii, i.e. 
minxeasi l|x-Pi|| > fii, and so D{pi,fii) C Bi. 

It follows from Proposition 1 that for any p G Conf {Q, (3) 
23 (p,/3) has no occupancy defect (Def. 1), i.e. pi G Bi \/i. 

The boundary dBi of Bi is defined by the boundary dQ 
of Q and the separating separating hyperplane between body 
cells Bi and Bj for some j f i [8]. By definition (15), we 
have miuxeaQ ||x - pi|| > fii for any p G Conf (Q,/3). 

Now observe that, for any i f j the separating hyperplane 
between body cells Bi and Bj is perpendicular to the line 
joining pi and pj and is given by [8] 


Hij:={x€l 


{xGR^ 2x'^(Pi-Pi) = /3|-/3,^ + ||Pif-||Pjf},(17) 


and the perpendicular distance of to Hij is given by 


^ (Pi 7 ^‘i'j ) 



P! - 

2iip* -Pjir 


(18) 


Note that d{pi,Hij) is negative when 23(p,/3) has an 
occupancy defect; and we have from Proposition 1 that 
23 {p,(3) is free of such a defect for any p G Conf (Q,/3) 
and so d{pi,Hij) > 0. One can further show that for any 


d (pi, ^ij) — fii 3~ 


l|Pi -p 4 -/3? -2/3i ||p» -Pi| 


2 p,; - 


Pi - Pi 

(||p.-p.||-/3.)^-/3| 
2 Up,- p,II 

'-V-" 

>0, since pGConf(Q,/3) 


> fii, 


(19) 


which completes the proof. 


To determine a collision free neighborhood of a configura¬ 
tion pGConf(Q,/3) with a vector of body radii /3 g(M>o)", 










Fig. 2. (left) Encoding collision free configurations via body diagrams: 
A configuration of disks is nonintersecting iff each disk is contained in the 
interior of its body cell, (right) Free subcells, obtained by eroding each body 
cell with its associated disk radius. 


we define a free subdiagram 3^ (p, /3): = {Fi, F 2 ,..., of 
the body diagram ® (p, /3) = {Bi , _B 2 , ■ • ■, Bn} by eroding 
each cell removing the volume swept along its boundary, 
dBi, by the associated body radius, see Fig. 2, as [17] ® 


F,:=B,\{dB,(BD{0,P,)) 


qGBi 


min||x-q||>/3i^.(20) 

xedBi 


Note that F] is a nonempty convex set because p^ G F] and 
the erosion of a convex set by a ball is convex. ^ 

The following observation yields a (possibly conservative) 
convex inner approximation of the free configuration space 
neighborhood surrounding free configuration as 

p G Conf (Q, /3) T (p, f3) C Conf (Q, /3), (21) 

where 3"(Pi /3) = ^1 x ^2 x ■ • ■ x F„. 

Lemma 1 Let p G Conf {Q,f3) be a multirobot configura¬ 
tion with a vector of body radii (3 G (]R>o)", and T (p,/3) 
be the free subdiagram of the body diagram 23 (p,/3). 

Then q G Q" is a collision free multirobot configuration 
in Conf {Q,f3) if qi G Fi (i.e. D {qi,/3i) C BJ for all i. 


Proof The results directly follows from 23 (p, /3) covering a 
partition of Q, as discussed in the proof of Proposition 2. ■ 


Now, in contrast to the standard “move-to-centroid” law 
that steers each robot directly towards the centroid, cs ^, of its 
sensory cell. Si, we propose a coverage control policy that 
selects a safe target location, called the constrained centroid 
of Si, that solves the following convex programming ® 

... 11 ii 2 


minimize ||qi — cs^ 
subject to qi G Fi 


( 22 ) 


where F^ is a closed convex set. It is well known that the 
unique solution of (22) is given by [18, Section 8.1.1] 


CSi 


cSi > if csi G Fi, 

n-p. (csj , otherwise. 


(23) 


where He (x) denotes the metric projection of x G 
onto a convex set C C R^, and note that lie is piecewise 
continuously differentiable [20]." Accordingly, for the single 
integrator robot dynamics (7), our “move-to-constrained- 
centroid” law is defined as 


Ui =-fc (pj - Csj , (24) 


where k G M>o is a fixed control gain, and we assume 
that §(p,(t) and T(p,/3+e) are continuously updated. 
We find it convenient to have G$ {Q, (3-\-e,cr) denote the 
set of equilibria of our “move-to-constrained-centroid” law 
where robots are located at the constrained centroid of their 
respective sensory cells, 


Gs(Q,/3+e,cr): = |pGConf ((3,/3+e) Pi=cs, Vi|.(25) 


In the special case of identical sensory footprint radii, i.e. 
CTi = (Tj for all i f- j, these stationary configurations are 
called the constrained centroidal Voronoi configurations [21]. 
Also note that for homogeneous point robots our “move- 
to-constrained-centroid” law in (24) simplifies back to the 
standard “move-to-centroid” law in (8). 

We summarize the qualitative properties of our “move-to- 
constrained-centroid” law as follows; 


B. Coverage Control of Heterogeneous Disk-Shaped Robots 

Consider a heterogeneous multirobot configuration p G 
Conf {Q,(3-\-e) with associated vectors of body radii (3 G 
(R>o)", safety margins e G (R>o)" and sensory footprint 
radii cr G (R>o)”, and let S (p, cr) = {Fi,..., Sn] be the 
sensory diagram of Q based on robot locations p and sensory 
footprint radii cr, and T(p,/3-|-e) = {Fi,...,F„} be the 
free subdiagram associated with configuration p and enlarged 
body radii /3-|-e. Here we use e to guarantee the clearance 
between any pair i j of robots to be at least Ci + e^ . ® 

®Here, 0 is a vector of all zeros with the appropriate size, and A ® 
B . = {a b I a £ A^b G B} is the Minkowski sum of sets A and B. 

^It is obvious that the erosion of a half-space by a ball is a half-space. 
Hence, since the erosion operation is distributed over set intersection 117], 
and a convex set can be defined as (possibly infinite) intersection of half¬ 
spaces [18], the erosion of a convex set by a ball is convex. 

^Having a positive vector of safety margins e enables us to consider col¬ 
lision free configurations in Conf {Q,/3-\-e) C Conf (Q,/3). Throughout 
the rest of the paper, in order the compress the notation, we will abuse the 
notation and use Conf (Q, f3-\-e) to refer to the closure of the configuration 
space in (15). 


Theorem 1 For any choice of vectors of body radii (3 € 
(R>o)^, safety margin e C (M>o)^ and sensory footprint 
radii crG (M>o)”, the configuration space of nonintersecting 
disks Conf((5,/3+e) (15) is positive invariant under the 
'Inove-to-constrained-centroid'' law in (24) whose unique, 
continuous and piecewise differentiable flow, starting at any 
configuration in Conf((5, /3+e), asymptotically reaches a lo¬ 
cally optimal sensing configuration in Gg (Q, /3+e, cr) while 

^Here, A is the closure of set A. 

*^In general, the metric projection of a point onto a convex set can be 
efficiently computed using a standard convex programming solver [18]. If 
Q is a convex polytope, then a free subcell, Fi, is also a convex polytope 
and can be written as a finite intersection of half-spaces. Hence, the metric 
projection onto a convex polytope can be recast as quadratic programming 
and can be solved in polynomial time [19]. In the case of a convex polygonal 
environment, Fi is a convex polygon and the metric projection onto a convex 
polygon can be solved analytically since the solution lies on one of its edges 
unless the input point is inside the polygon. 

Note that cs is well defined (see footnote 4), hence cgi must be as 
well given Fi / i. 

Note that this set cannot be empty since it contains the minima of a 
smooth function over a compact set (22). 
















strictly decreasing the utility function !Ks(-,cr) (10) along 
the way. If an equilibrium in Gg{Q, f3+e,cr) is isolated, 
then it is locally asymptotically stable. 


Proof. The instantaneous ’’target” in (24) lies in the clo¬ 
sure of the convex inner approximation to the freespace 
neighborhood of any free configuration, Cs(p_o.) £ 
n3^(p,/3+e) C Conf (Q,/3-|-e), hence, according to 
Lemma 1, the configuration space tangent vector defined 
by (24), -fc (p - Cs(p,o-)) £ TpConf (Q,/3+e), is either 
interior directed or, at worse, tangent to the boundary of 
n3^(p,/3 + e)- Therefore, by construction (22), the “move- 
to-constrained-centroid” law leaves Conf((5,/3+e) posi¬ 
tively invariant. 

The existence, uniqueness and continuity of its flow can 
be observed using an equivalent hybrid system consisting of 
a family of piecewise continuously differentiable local vector 
fields as follows. Let \i^ ■.'Dj ^ (K^)” be a local controller 
associated with a subset I of {1, 2,..., n} defined as 


r-fc(pi - CsJ , if z £ / 

( 0 , otherwise, 


(26) 


where its domain is 

D/ := (p£Conf (g,/3-fe) 7 ^ 0 Vz £ / 


} ■ (27) 


Note that for a given configuration in its domain, D/, a 
local policy index, I, indicates which robots are assigned 
to sensory cells with nonempty interiors, and so the do¬ 
mains, “Dj, of local controllers defines a finite open cover 
of Coni {Q, f3+e). Hence, since all unassigned robots are 
stationary under the “move-to-constrained-centroid” law and 
every robot whose sensory cell has a nonempty interior is 
assigned to the coverage task, one can further conclude that 
these local controllers can be composed using the policy 
selection strategy, g : Coni (Q, f3+e) P (n) maximizing 
the number of assigned robots,'^ 


g{p) := arg max |/| . (28) 

/C{l,...,n} 

pe®/ 


piecewise continuously differentiable since each free cell 
is a nonempty erosion of an element of the body diagram 
H {p,l3 -\- e) by a fixed closed ball. Hence, one can conclude 
that each local control policy is piecewise continuously 
differentiable since metric projections onto convex cells are 
piecewise continuously differentiable [20] and the compo¬ 
sition of piecewise continuously differentiable functions are 
also piecewise continuously differentiable [22]. 

Therefore, the existence, uniqueness and continuously 
differentiability of the flow of each local controller follow 
from the Lipschitz continuity of in its compact domain 
Di since a piecewise continuously differentiable function 
is also locally Lipschitz on its domain [22] and a locally 
Lipschitz function on a compact set is globally Lipschitz 
on that set [23]. Hence, since their domains define a finite 
open cover of Conf (Q,/3 -f e), the unique, continuous and 
piecewise differentiable flow of the “move-to-constrained- 
centroid” law is constructed by piecing together trajectories 
of these local policies. 

Finally, a natural choice of a Lyapunov function for the 
stability analysis is the continuously differentiable location 
optimization function Tfg (10), and one can verify from (11), 
(22) and (24) that for any p £ Conf {Q,(3+e) 

n 

TCs (p,cr) = -kY^mSi 2(p* - (pi - csJ , (30) 

i^l '' ~ ^ 

since piGFi and ||pi—csj| cSi|| 

n 

<-fc^msJlpi - csJI^ < 0, (31) 

i=l 

which is equal to 0 only if p^ = csi for all i, i.e. 
p £ Gs (Q,/3+e, cr). Thus, it follows from LaSalle’s 
Invariance Principle [23] that all multirobot configurations 
in Conf {Q,P+e) asymptotically reach Gg {Q, f3+e,cr). If 
an equilibrium p* in Gg (Q, f3+e,cr) is isolated, then it is 
guaranteed that Tfg (p, cr) < 0 in a neighborhood of p*, and 
so it is locally asymptotically stable [24]. ■ 


such that the resulting hybrid vector field is the same as 
the “move-to-constrained-centroid” law in (24), i.e. for any 
p £ Conf (Q,(3+e) 

u (p) == (p). (29) 

Note that, since a sensory cell with a nonempty interior can 
not instantaneously appear or disappear under any continuous 
motion, each time when a local controller is selected by g it 
steers the robots for a nonzero time. 

Now the continuity properties of each local control policy 
can be observed as follows. As in the case of Voronoi 
diagrams [16], we have that the boundary of a sensory 
cell with a nonempty interior is a piecewise continuously 
differentiable function of robot locations, and its centroid is 
continuously differentiable with respect to robot locations. 
Similarly, the boundary of each element of T(p,/3-|-e) is 


C. Congestion Control of Unassigned Robots 

In this subsection we shall present a heuristic congestion 
management strategy for unassigned robots that improves 
assigned robots’ progress. 

For a choice of vectors of body radii /3 £ (K>o)”, safety 
margins e£(]R>o)" and sensory footprint radii cr£(]R>o)", 
let p € Coni{Q,f3+e) be a multirobot configuration 
in Q with the associated body diagram 'B(p,/3-|-e) = 
{Bi,..., B„}, free subdiagram T (p, f3 + e) = {Fi,..., F„} 
and sensory diagram § (p, cr) = {S'!,..., S'n}. 

Consider the following heuristic management of robots: 
if zth robot has a sensory cell Pi with a nonempty interior, 
then it is assigned to the coverage task with sensory cell 
Sf, otherwise, since the robot becomes redundant for the 
coverage task, it is assigned to move towards a safe location 


*'^Here P (n) denotes the set of all subsets of {1, 2,..., n}. 


14aT 

is the transpose of matrix A. 




in Bi. We therefore define the set of "active” domains 
A (p, /3+e, cr) = {Ai,A 2 , ..., An} of robots as 

(32) 

Bi , otherwise. 

Note that A{p,f3+e,a) defines a cover of Q and its 
elements have nonempty interior for all p G Conf (Q,/3+e) 
(Proposition 2). 

For the first order robot dynamics (7), we propose the 
following “move-to-constrained-active-centroid” law 

Ui =-k{pi-CAi), (33) 


that steers each robot towards the constrained centroid, CAi as 
defined in (23), of its active domain, Ai, which is the closest 
point in Fi to the centroid CAi and so uniquely solves [18] 

minimize Hq^-CAif 
subject to qi G Fi 


where Fi is convex and k G M>o is a fixed con¬ 
trol gain. Once again, we assume that 71 (p,/3-|-e, cr) and 
{p, f3+e) are continuously updated. It is also useful to 
have Ga {Q, /3 + £,ct-) denote the set of equilibria of the 
“move-to-constrained-active-centroid” law where robots are 
located at the constrained centroid of their active domains. 


Gyi((3,/3-l-e, cr): = |pGConf {Q,f3+e) 


= C 4 .- Vi 


Pi=CA 


i}.(35) 


We summarize some important properties of our “move- 
to-constrained-active-centroid” law as follows: 


Proposition 3 For any f3,cr € (R>o)" and e G (K>o)", the 
“move-to-constrained-active-centroid” law in (33) leaves the 
configuration space of nonintersecting disks Conf(Q,/3-|-e) 
positively invariant; and its unique, continuous and piece- 
wise differentiable flow, starting at any configuration 
in Conf (Q,/3-|-e), asymptotically reaches Ga^Q, f3+c, cr) 
without increasing the utility function ?£§(•, cr) (10) along 
the way. 


Proof The positive invariance of Conf {Q,^-\-e) under the 
“move-to-constrained-active-centroid” law and the existence, 
uniqueness and continuity properties of its flow follow the 
same pattern as established in Theorem 1. 

For the stability analysis, using (11), (33) and (34), one 
can show that the continuously differentiable utility function 
Tfs (.,cr) ( 10 ) is nonincreasing along the trajectory of the 
“move-to-constrained-active-centroid” law as follows: 


DTs (p,(t) = -k 


'Y' msi 2(pi-csj"^(pi-csj 




since PiGF i and pi—csJ >| cs. —cs- 


YL, 2(pi-csj'’"(pi-CBj, (36) 

ie{G...,n} 

*5^—0 since Si—0 

<-k Y2 ||pi - < 0. (37) 


Hence, we have from Lasalle’s Invariance Principle [23] that, 
at an equilibrium point of the “move-to-constrained-active- 
centroid” law, a robot is located at the constrained centroid, 
C 5 ., of its sensory cell. Si, if it has a nonempty interior, i.e. 
Si f 0. Given that pi = cs^ for all * G {1,... ,n} with 
Si f 0, using (11), (33) and (34), one can further show that 

T£b (p,/3+e) =-fc YZ 2(p,-csJ'^(pj-cs,) 

since pi=c 5 ^ 

- k Y2 _2(pi-csj'^(pj-CBi) , (38) 

ie{l,...,n} _ 

Si=0 >||Pt-CBi|l^. 

since piGi^i and ||pi— cb^ || >||cBi—CBi|| 

<-k Y2 Up* “ < 0 . (39) 

iG{l,...,n} 

Si =0 

Therefore, at a stationary point of (33) ith robot is located at 
the constrained centroid, csi, of its body cell Bi if Si = %. 
Overall, by Lasalle’s Invariance Principle, we have that any 
multirobot configuration starting in Conf (Q,/3+e) asymp¬ 
totically converges to a locally optimal sensing configuration 
in Ga {Q: I^Fc,cr), which completes the proof. ■ 


D. Coverage Control of Differential Drive Robots 

Consider a noncolliding placement of a heterogeneous 
group of disk-shaped differential drive robots (p, 6) G 
Conf {Q,(3+e) x (— 7 r, 7 r]” in a convex planar environment 
Q C with associated vectors of body radii (3 G (R>o)", 
safety margins e G (R.>o)" and sensory footprint radii 
cr G (R>o)”, where 9 = (0i,02,... ,0n) is the vector of 
robot orientations. 

The kinematic equations describing the motion of each 
differential drive robot are 

(40) 

0i = iOz, 


Pi = Vi 


cos 0i 
sin 0i 


where G K and G R. are, respectively, the linear 
(tangential) and angular velocity inputs of ith robot. Note 
that the differential drive model is underactuated due to the 

r . T T 


nonholonomic constraint 


— Sill Ui 
COS 9i 



Let § (p, cr) = {5'i,..., Sn} (9) be the sensory diagram of 
Q based on robot locations p and sensory footprint radii cr, 
and T (p, /3-|-e) = {Fi ,..., F„} (20) be the free subdiagram 
associated with configuration p and enlarged body radii (3 + 
e. For a choice of e G (R>o)" with e; > Ci for all i, we 
further define T(p, l3 + e) = {Ti, T 2 ,..., r„} to be 


Ti :=conv({pJ UF/) (41) 


where J(p,(3+e) = {F[, F 2 ,..., F))} and conv (A) de¬ 
notes the convex hull of set A. Note that, since F/ C Fj, 
Pi G Fi and Fi is convex, every element of 7 (p, f3 + e) 
is contained in the associated element of T(p,/3+e), i.e. 
Ti C Fi. It is useful to remark that we particularly require 
Pi G Ti to guarantee an optimal choice of a local target 










position in (45) relative to pi, and we construct subset Ti of 
Fi to increase the convergence rate of our proposed coverage 
control law in (47). 

As in the case of “move-to-constrained-centroid” law of 
fully actuated robots in (24), for optimal coverage each 
differential drive robot will intent to move towards the 
constrained centroid, csi (23), of its sensory cell. Si, but 
with a slight difference due to the nonholonomic constraint. 
To determine a linear velocity input guaranteeing collision 
avoidance, we select a safe target location that solves the 
following convex programming. 


minimize ||qi — csj|^ 
subject to (\i & Fir\F[i 


(42) 


where 




|x G Q 


cos 6i 
sin 9i 



(43) 


is the straight line motion range due to the nonholonomic 
constraint. Note that Fi Ci Hi is a closed line segment in Q. 
Hence, once again, the unique solution of (42) is given by 




CSi , if CSi G n H^, 

^FinHi (cSi), otherwise, 


(44) 


where lie is the metric projection map onto a convex set 
C. Similarly, to determine robot’s angular motion, we select 
another safe target location that solves 

minimize llqi — cs.ll^ 

" _ (45) 

subject to qi G Ti 


where Ti C Fi is convex, and the unique solution of (45) is 




cSi , if cSi G Ti, 
IIt (‘"Si)’ otherwise. 


(46) 


Accordingly, based on a standard differential drive con¬ 
troller [25], we propose the following “move-to-constrained- 
centroid” law for differential drive robots,'^ 


Vi = -k 


COS 6i 
sin 9i 


/ 

uji = k atan 

V 


T 


(Pi -cs,) , 


(47a) 

(47b) 


where /c > 0 is fixed. Having G-r, {Q, (3, e, e, cr) denote its 
set of stationary points where the constrained centroids Cg 
and Cg. coincide and ith robot is located at Cg. = c^.. 


Gd (Q,/3, ecr):= |p G Conf (Q,/3-I-e) 


— ~'^Si 


we summarize important qualitative properties of the “move- 
to-constrained-centroid” law of differential drive robots as: 


Proposition 4 For any f3,cr G (K.>o)" and e,e G 
(R>o)” with Ci < £i for all i, the “move-to-constrained- 
centroid” law of differential drive robots in (47) asymp¬ 
totically steers all configurations in its positively invariant 


'^To resolve indeterminacy we set uii = 0 whenever pi = Cg . 


domain Conf (Q, f3-\-e) x (—tt, tt]" towards the set of optimal 
sensing configurations Gd (Q, (3, e, e, cr) x (—tt, tt]” without 
increasing the utility function 3{g (■,cr) (10) along the way. 

Proof The configuration space Conf (Q, (3-\-e)x(—'K, tt]" is 
positively invariant under the “move-to-constrained-centroid” 
law in (47) because, by construction (42), each robot’s 
motion is constrained to the associated safe partition subcell 
in Q. The existence and uniqueness of its flow can be 
established using the pattern of the proof of Theorem 1 and 
the flow properties of the differential drive controller in [25]. 

Now, using Tfg (', cr) (10) as a continuously differentiable 
Lyapunov function, we obtain the stability properties as 
follows: for any (p,0) G Conf (Q,[3-\-e) x (—7r,7r]" 

n 

TCs (p, (t) = -k'^ mg, 2(p, - (pi - Cg.) , (48) 

V V 

2=1 -- 

since pi^FiDHi and ||pi—cs^ || >||c^. —|| 

n 

<ms, ||pi-CgJI^ < 0, (49) 

2 = 1 


where pi = —k (pi — c^J. Hence, by LaSalle’s Invariance 
Principle [23], at a stationary point of (47) ith robot is located 


at c l 


Since for fixed Cc 


and Cg. 


the standard differential 


drive controller asymptotically aligns each robot with the 
constrained centroid Cg., i.e. ‘ (Pi^^s,) = 0 [25], 

it is guaranteed by (42) and (45) that Cg. = Cg whenever 

T ’ ‘ 

(pi —Cs,) = 0. Therefore, 


P* - Cs,| 


= 0 and 


— sin 8i 
COS 9i 


we have from LaSalle s Invariance Principle that all config¬ 
urations in Conf (Q,(3 + e) x (— 7 r, 7 r]" asymptotically reach 
Gd ((5,/3, e,£, cr) X (- 7 r, 7 r]”. ■ 


Finally, note that the “move-to-constrained-active- 
centroid” law of Section IV-C can be utilized for congestion 
control of differential drive robots by using active domains 
in (32) instead of the sensory diagram §(p,cr), and the 
resulting coverage law maintains qualitative properties. 


V. Numerical Simulations 

A common source of collisions between robots while 
performing a distributed sensing task is a concentrated event 
distribution which generally causes robots to move towards 
the same small region of the environment.'® We therefore 
consider the following event distribution, f : [ 0 , 10 ]^ —>■ K>o, 
for a homogeneous group of disk-shaped robots operating in 
a 10 X 10 square environment, 

(j)(q) = e Ih [ ^ill . (50) 

In Fig. 3 we present the resulting trajectories of our proposed 
coverage control algorithms. Since the event distribution 


^^For all simulations we set = 0.05 and ei = 0.1 for all 
i € and all simulations are obtained through numerical 

integration of the associated coverage control law using the ode 4 5 function 
of MATLAB, and the computation of the centroid of a power cell in (6) is 
approximated by discretizing the power cell by a 20 x 20 grid. 




















Fig. 3. Avoiding collisions around a concentrated event distribution, (a) Initial configuration of a homogeneous robot network, where the weight of sensory 
cell are shown in the parenthesis, and the resulting trajectories of (b) the standard “move-centroid” law (12), (c) the “move-to-constrained-centroid” law 
(24), (d) the “move-to-constrained-active-centroid” law (33), (e) the “move-to-constrained-centroid” law of differential drive robots (47) which are initially 
aligned with the horizontal axis. 



Fig. 4. Safe coverage control of heterogeneous disk-shaped robots with a heuristic management of unassigned robots, (a) Initial configuration of a 
heterogeneous robot network, where the weight of sensory cell are shown in the parenthesis, and the resulting trajectories of (b) the standard “move- 
centroid” law (12), (c) the “move-to-constrained-centroid” law (24), (d) the “move-to-constrained-active-centroid” law (33), (e) the “move-to-constrained- 
active-centroid” law of differential drive robots which are initially aligned with the horizontal axis. 


is concentrated around a small region, as expected, the 
standard “move-to-centroid” law steers robots to a centroidal 
Voronoi configuration where robots collide. On the other 
hand, since a Voronoi partition has no occupancy defect, our 
“move-to-constrained-centroid” and “move-to-constrained- 
active-centroid” laws yield the same trajectory that asymp¬ 
totically converges a collision free constrained centroidal 
Voronoi configuration. It is also well known that minimizing 
the location optimization function Jfg (10) generally results 
in a locally optimal sensing configuration, and we observe 
in Figures 3.(c) and 3.(e) that, although they are initiated at 
the same location, fully actuated and differential drive robots 
asymptotically reach different constrained centroidal Voronoi 
configurations. 

To demonstrate how unassigned robots may limit the 
mobility of others, we consider a heterogeneous group of 
disk-shaped robots operating in a 10 x 10 environment with 
the following event distribution function, (p : [0,10]^ —>■ K>o, 

_ 1II _r 81 |P _ 1II _r 81 |P 

</)(q) = l + 10e Hr i»Jll +e HH 


which is also used in [7]. In Fig. 4 we illustrate the resulting 
trajectories of our safe coverage control algorithms. As seen 
in Fig. 4. (a), the 2nd robot is initially not assigned to any 
region. It stays stationary for a certain finite time under the 
the standard “move-to-centroid” law during which the 1st 
robot moves through it. Also notice that the 3rd robot violates 
the workspace boundary before converging a safe location. 
In summary, the “move-to-centroid” law steers disk-shaped 


robots to a locally optimal sensing configuration without 
avoiding collisions along the way. Our “move-to-constrained- 
centroid” law prevents any possible self-collisions and colli¬ 
sions with the boundary of the environment. However, since 
the 2nd robot stays unassigned for all future time, the 1st 
robot is blocked and it can not move to a better coverage 
location. Fortunately, while guaranteeing collision avoidance, 
our “move-to-constrained-active-centroid” law steers unas¬ 
signed robots to improve assigned robots’ progress for both 
fully actuated and differential drive robots, as illustrated in 
Figures 4.(d) and 4.(e), respectively. 

VI. Conclusion 

In this paper we introduce a novel use of power diagrams 
for identifying collision free multirobot configurations, and 
propose a constrained optimization framework combining 
coverage control and collision avoidance for fully actuated 
disk-shaped robots, comprising the main contributions of the 
paper. We also present its extensions for the widely used 
differential drive model and for congestion management of 
unassigned robots. Numerical simulations demonstrate the 
effectiveness of the proposed coverage control algorithms. 

Work now in progress targets another extension of 
Voronoi-based coverage control for hierarchical settings, 
based on nested partitions of convex environments [26]. We 
also believe that encoding collision free configurations in 
terms of power diagrams might have a significant value for 
robot motion planning, and we are currently exploring its 
possible usage in the design of feedback motion planners. 
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